bool isValid
TrajectoryPoint Reference_State
